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(57)Abstract: 

PURPOSE: To easily realize posture stabilizing control 
by providing a means for detecting the actual inclination 
and/or actual inclination speed of a robot and a means 
for comparing the detected value with an instructed 
value to determine the deviation. 

CONSTITUTION: The output of an inclination sensor 40 
is transmitted to a RAM 54 through a bus 52. The output 
of an encoder arranged adjacent to each electric motor 
is inputted to the RAM 54 through a counter, and the 
output of grounding switch 38 is similarly stored in the 
RAM 54 through a waveform shaping circuit 58. A 
control unit 26 has first and second arithmetic devices 
60, 62 consisting of CPUs, and the first arithmetic 
device 60 calculates the joint driving pattern of a target 
joint angle and transmits it to the RAM 54. The second 
arithmetic device 62 reads the target value and the 
detected actual measurement value, calculates a control 
value necessary for driving each joint and outputs it to 
the electric motor for driving each joint. 
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